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ABSTRACT 


A computer simulation was developed in order to provide 
a method of establishing the potential of brushless DC 
motors for applications to tactical cruise missile control 
surface positioning. In particular an altitude hold 
controller has been developed that provides an operational 
load test condition for the evaluation of the 
electromechanical actuator. 

A proportional integral control scheme in conjunction 
with tachometer feedback provides the position control for 
the missile tailfin surfaces. The fin control system is 
further imbedded in a cruise missile model to allow altitude 
control of the missile. 

The load on the fin is developed from the dynamic fluid 
environment that the missile will be operating in and is 
proportional to such factors as fin size and air density. 

The program written in CSMP language is suitable for 
parametric studies including motor and torque load 


characteristics, and missile and control system parameters. 
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l. INTRODUCTION 


Hydraulic actuators have been the most effective means 
to control the fins of cruise missiles for many years. High 
torque loads are often felt on the control surfaces and 
heretofore servo motor control has not often been attempted 
because of size constraints and the necessary torques 
required to dynamically control the missile fins. 

The advent of brushless DC motors possessing very strong 
magnetic fields presents an opportunity to investigate 
missile control using these motors rather than the more 
conventional hydraulic actuators. A simplified model of a 
brushless DC motor is used as a basis for a fin positioning 
controller. This controller is then utilized in a 
simplified generic missile model to develop an altitude hold 
controller: The characteristics of the DC motor can be 
adjusted to determine the ability of that particular motor 
to dynamically control the fins of the missile and 
ultimately to dynamically control a missile in. £ Ligi: 

Four phases of development are necessary to develop the 
computer program for missile flight simulation. The first 
phase entails the development of the DC motor model and the 
necessary assumptions. The second phase places the motor in 


a proportional - integral (PI) controlling system with 


tachometer feedback supplementing the natural back 
electromotive force (BEMF) exerted by the motor itself. 
Next the missile model is developed. The final phase is the 
development of an altitude hold controller which 
incorporates the missile model and the fin positioning 
controller. 

To verify the CSMP simulation, the equations of motion 
were also programmed in the FORTRAN language. These 
routines were used to compare the test runs described in 
section V., for accuracy of the model simulation. 

The computer program provides to the user, the ability 
to modify the motor parameters, missile parameters, and to 
adjust the dynamic characteristics of the fin controller and 
altitude hold controller. This program provides an effective 
tool in the study of brushless DC motor actuators used in 


dynamic missile systems. 


II. DC MOTORGMUODEDSDEVELOPMENT 


The initial brushless DC motor model developed by Steve 
Thomas [Ref. 1]. has been used as a starting point for this 
work. Program number 2 of [Ref. 1] incorporated a 
commutator switching scheme to allow modeling of brushless 
operation, See Fig. 2.1. The need to create a model which 
will allow the study of motor performance under dynamic load 
conditions as well as static load conditions Seems to be a 
natural follow on to the work performed in [Ref. 1]. 

It is well known that the electrical time constant of a 
DE motor is small compared to the mechanical time constant 
of the motor. This allows the assumption that the armature 
inductance is small enough to neglect. Using this 
knowledge, a continuous model of the DC motor with the same 
physical parameters as in [Ref. 1] has been selected, see 
Plg. 29) In computer simulation of navigation type 
controllers, only the slower time constants are of interest. 
Whenever fast time constants are also included, 
computational difficulties are encountered because of the 


small integration time interval requirements. 





Figure 2.1 Basic Brushless DC Motor Model 
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Figure 2.2 Modified DC Motor Model 
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IT S LI TL LON CONTROLLER 


A. TORQUE GENERATION MODEL 

One of the first steps in the design of a fin position 
controller is to design a dynamic input to the load torque 
of the DC motor model. This is accomplished using the 
dynamic lift force relationship established in [Ref. 3], as 


follows: 


Lift Force = (Cl x air density x area x velocity?) / 2 
where Cl is the force coefficient 


Cl = velocity x characteristic length / kinematic viscosity 


The force coefficient is usually determined 
experimentally from airfoil tests. The lift force is 
defined to be perpendicular to the velocity vector of the 
fin. The total force vector is the sum of the lift force 
and the drag force vectors. 

Some simplifying assumptions have been made. The total 
force vector is assumed to be approximately equal to the 
lift force vector for small fin deflections ie. less than 15 
degrees deflection above or below the velocity vector. The 
coefficient of drag is less than one tenth the coefficient 


of lift for these angles, see Fig. 3.1. 


Je 


In the computer simulation, Cl is modeled as a linear 
ramp that saturates at plus or minus 13 degrees fin 
deflection, and is approximately equal to 1⁄10 fin 
deflection angle. The lift force is converted to a torque 
by multiplying by the moment-arm. The moment-arm is the 
distance from the rotational axis of the fin to it's center 
of pressure. Although in a dynamic system the center of 
pressure changes slightly, it has been assumed that it is 
constant. Fig. 3.2 shows the torque load block diagram. 
System generated Motor torque and Load torque for maximum 
size Step inputs is shown in Fig. 3.3 and Fig 3.4 


respectively. 


B. TACHOMETER FEEDBACK 

Inherent back emf of the motor provides some speed 
regulation, but is not sufficient to adequately control the 
motor speed. The back emf constant of the motor is 
supplemented by an additive constant that would be provided 
by a tachometer. This rate feedback allows the desired 


speed regulation and quick response to commanded inputs. 


a PROPORTIONAL INTEGRAL CONTROL 
1. General 
A series proportional-integral control scheme is 
used for precise position control of the fin. The position 
error is generated by closing the loop with a constant gain 


amplifier as shown in Fig. 3.5. 
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2. Transfer Function Analysis 


The uncompensated motor transfer function is easily 
obtained for various system parameters using Program 1 
written in Basic language in appendix C. A sample output is 
provided in appendix B. For the parameters used in this 
simulation the uncompensated motor transfer function Gl(s) 


becomes: 


The open loop transfer function is linearized by 
restricting the operational range so as to not include the 
saturation region of the coefficient of lift equation, (this 
is not necessary for program operation, but only for linear 
analysis. The forward loop transfer function G(s) = 


Gc(s)Gl (s) becomes: 


S(3180)»+ (1586) 


where Gc(s) is the transfer function for the PI controller. 
Using the coefficients derived from this forward transfer 
function and including the feedback constant (Knvrt), which 
has been set to 35, the compensated open loop and closed 


loop Bode plots can be seen in Fig. 3.6 and Fig. 3.) 
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respectively. System response is quite fast with a response 
time of 3 msec. for full scale fin deflection accurate to 
within .01 degrees of desired fin angle. 

For substitution of the Fin controller mo the 
missile plant the overall fin controller transfer function 
can also be evaluated using Program 1 in appendix C. This 


transfer function 


Geq(s) = G(s)/l + G(S)H(s) 


for the parameters used in this Simulation is as follows: 


Seo ES ier + (1599) 


3. Bode Analysis 


Bode plot analysis was used to design the fin 
position controller. The motor transfer function including 
velocity feedback and torque load generator is reduced to 


the equivalent transfer function 
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Mee all transfer fetio coefficients are detailed iff 
Program l appendix C. and can be obtained for specific 
parameters. 

This is a type zero system which for the constants 
chosen (see appendix C for chosen parameters) yields poles 
at -.71 and -5865. The permanent magnet motor itself is a 
type l system. Derivation of the torque felt from the fin 
allows reduction of the system to a single input single 
output system, however it uses a feedback loop which causes 
the effective transfer function of the motor system to 
become a type 0 system. The motor system also includes 
velocity feedback which was derived from the original back 
emf constant of the system plus an additional amplifier to 
boost the rate feedback stabilization effect. Without 
boosting this feedback which is easily derived with the use 
of a tachometer the system oscillates and does not damp out 
well. 

The obvious thing to do with the motor system 


transfer function Gl(s) is to increase it to a type l system 


to allow zero steady state error to a step input. A 
proportional-integral (PI) controller 1S chosen with 
constants Kp and Ki such that Gc(s) = Kp + Ki/s. This PI 


controller is placed in cascade with the motor System 
transfer function to yield the forward system transfer 


function G(s) as follows: 


Is 


The effect of the PI controller is to "INCESJNES a 
pole at zero, and a zero at -Ki/Kp. Ki has been chosen to 
be 100 and Kp has been chosen to be 200. These values 
position the new system zero at minus .5. This zero is to 
the left of the dominant system root and allows very quick 
servo mechanism response, in a system which is stable for 
all positive values of system gain. A damping ratio 
approximately equal to .44 is achieved with the PI 
controller: From the Open loop Bode plot the phase margin 
is 44 degrees, gain margin is 7 DB, and band pass frequency 
is 4000 rad/sec. The peak frequency magnitude is 1.36 at 
5000 rad/sec as seen on the closed loop Bode plot Fig. 3.7. 
From [Ref. 4] second order approximations show the natural 
frequency to be 2920 rad/sec, settling time is .003 sec, 
overshoot magnitude is 1.24, system time constant is .00086 
Sec., and transient oscillating frequency is 2676 rad/sec. 
Figure 3.8 shows the fin controller time response using the 
parameters described above. 

The Bandwidth of the fin controller is strongly 
influenced by the feedback constant H(s). This feed back 
gain is set equal to 35 x N, where N is the gear reduction 


of the fin mechanism (N = 10 in this simulation). This 
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large negative feedback constant greatly increases the 
bandwidth of the system, but is able to achieve quick fin 
response times without long settling times. Trials were 
conducted to attempt to reduce the system bandwidth by 
IEScacing the FPiSzeEe further in the left half plane. It is 
possible to reduce the system bandwidth in this manner, 
however a tradeoff must be made in sacrificing response 
time. System bandwidth can be reduced to about 1808 
rad./sec. by placing the compensator zero at minus 50 by 
setting Ki = 188 and Kp = 2, see open and closed loop Bode 
PIGGEWE1gures Beem and 3.10. Doing this allows a motor 
response time for full scale fin deflection of „05 sec., 
(see Figure 3.11) which would be adequate for many cruise 
missle applications. 

Additional controller designs such as the use of 
derivative as well as proportional and integral control and 
lead-lag filter sections could be developed to provide low 
bandwidth and fast fin response times, however the 
optimization of the controller design as stated in Section 


II. was not the primary objective of this work. 
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Flgure 3.2 Torque Load Block Diagram 
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Figure 3.3 Motor Torque Response to Step Input 
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Figure 3.4 Load Torque Response for Step Input 
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Figure 3.6 Open Loop Bode Plot Ki 
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Figure 3.7 Closed Loop Bode Plot Ki 
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Figure 3.8 Fin Position Time Response 


24 


00001 


0001 





DAS/AVA) AONANDAA 
001 OI 


LO Id 21404 


100 


06- 081- 


EN END WN 


C 


0 


Flgure 3.9 Open Loop Bode Ki = 100, 


2 


Kp = 


25 


LI ANIL 
00001 000I DO! Øl 


— HGOLINOVN o = bo =A BQ 
(Nd): I 
MENITE || 
[l ||| 


LOTA OE 


— 


10°0 | 

e 

INOD = 
-9 

O 

-© 

Cn 

a | 

o 

m 


CQ 





JUNLINDVN 


| 


— vi 
DO A A 


Figure 3.10 Closed Loop Bode Ki - 100, Kp = 2 


26 


(OMS) SELL 
01 0 600 000 LO O 90 0 G0 0 rO O £0°0 o0 0 100 000 





on 


-e-1N-091—3-091-4—d: o 
8 
| 
E 
md 
un 
E 
O 
k O "4 
Ð 
-2 E 
S 
e 
IION A NI: di 
4OVLTOA LOdNI S 
NADA x 
DD 
3 


de TIOALNOD NOLLISOd Nie 


= 


Figure 3.11 Fin Position Time Response 
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LV MISSILE MODEL DEVELOPMENT 


In order to study the effects of missile flight upon the 
motor, the missile system dynamics must first be adequately 
modeled. The missile equations are developed with reference 
to Fig. 4.1, which shows diagramatically the missile pitch 
plane dynamics. Control of the missile in the yaw plane can 
be accomplished in a similiar manner. The pitch plane was 
chosen so that the effects of gravity can easily be 
incorporated in the study of the motor characteristics. 

A description of the missile plant, operating 
conditions, and specific system parameters used in the 
simulation are needed as ground work for a thorough 
understanding of the Pitch plane dynamic equations to be 
developed. Pitch control is effected by means of a rear 
mounted movable aerodynamic fin with total surface area 
equally distributed on each side of the missile for a total 
of two square feet. It is assumed that both fin sections 
operate together using one DC motor for control. In actual 
operation four fins each independently controlled by one DC 
motor is more likely. Missile roll stability is assumed to 
be provided by a similiar vertically oriented system, but 
certainly possessing independently controlled fins. 


Vertical missile orientation DE thor ore ase o dir o Me ke 
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model and is assumed to be constant. The missile length is 
ten feet, effective surface area is twelve feet and the 
weight of the missile is assumed to be 1000 pounds. The 
missile is assumed to be a narrow rigid body for purposes of 
computation of the moment of inertia in the transverse 
plane. This assumption leads to the following moment of 
inertia (Iz) equation (see appendix A for equation symbol 


definitions): 


Iz - (1/ 12) x MASS x Lm? 


where Lm is the missile length. The formulation of a force 
balance equation with respect to the reference missile 


direction yields: 


d^y 
ua = [CK X a) - (K. X Y) = wn] / MASS 


where a is the missile attack angle, Y is the angle between 
the missile axis and the horizontal reference (pitch angle), 
and where Wn = mg cos(¢) and Gs H fór a horizontally 
referenced system, i.e. the X direction is along the earths 
surface. A moment balance about the missile pitch axis 


gives: 


209 


d^ Y d Y 
= = |(K, x 6) = “UE, x 0) (K= x = er 
END 3 4 NE 


The constants Kl through K5 in the missile equations of 
motion above are derived from the aerodynamic 


characteristics of the fin and the missile and give: 


K., = (Clm) x (Am) x (Qk) 
Ko = (Cdm) x (Am) x (Qk) 
KR, = (C1f) x (Af) x (Qk) x (L,) 
K, - (Clm) x (Am) x (Qk) x (L4) 


Kc - [(Cmq) x (Am) x (Lm)Ž x (Ok)] / [2 x (Vm)] 


where Cmq (missile moment coefficient) is assumed to be .5 
and Cl (coefficient of utt Oo both the TOA AGEE 
missile) is set to .1 while the drag coefficient Cdm is 
set to Hl using the lift coefficient curves from wind 
tunnel data similiar to those of Fig. 3.1. 


` 


Ok » (Pair / 2) x (Vm? 


Pair has been assumed to be constant at .002378 (slugs/£t?) 
for near sea level operation and Vm, the missile velocity is 
2000 ft/sec.. The missile surface area and fin surface area 


2 2 


(Vm and Vf) have been set to 12 ft^ and 2 ft” respectively. 


The missile center of pressure moment arm about the missile 
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center of gravity (Ll) has been set to l foot and the fin 
moment arm about the missile center of gravity (L2) has been 
set to 5 feet. 

The pitch angle of the missile (Y) is equal to the sum 
of the missile attack angle (4) and (B), where £ is the 
direction of the missile's velocity vector with respect to 
the horizontal reference . This assumes that there are no 
vertical crosswinds. 

The vertical reference direction normal to the earths 
surface is referred to as the "Y" direction, "X" is the 
horizontal coordinate of the earth reference system and is 
the direction of missile flight. "Z" is the transverse 
coordinate. Propulsion of the missile along the "X" 
direction is assumed to be provided by a separate thrus- 
control system such that the horizontal component of missile 
velocity remains constant. 

The missile plant must be merged with the motor driven 
min positioning controller. High speed DC motors using 
rare earth permanent magnets for field excitation permit 
relatively high voltage inputs on the order of 150-200 VDC 
to operate at maximum speed. A limitation of 160 volts has 
been established in this simulation and allows approximately 


+ or - 26 degrees of fin deflection for missile control. 
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Figure 4.1 Missile Pitch Plane Dynamics 
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EARTH REF 


V. ALTITUDE HOLD CONTROLLER 


The purpose of the design of an altitude controller in 
this simulation is to provide a means of accessing the real 
eee a typical” state of the art brushless DC motor to 
adequately control a typical tactical cruise missile in 
Steady state flight. Parameters may be varied to model 
Specific missile parameters including missile length, 
welght, effective surface area, distance from center of 
gravity to the center of pressure of the missile and to the 
center of rotation of the fin axis, and the control surface 
Size. Control system parameters can be adjusted to within 
reasonable limits to allow system bandwidth to be above 100 
radians per second if desired. The amount of position 
overshoot can also be minimized however a tradeoff in time 
required to reach the desired steady state altitude will 
OGEUE. 

Tt is desired in this simulation to design the 
controller so that for the typical cruise missile 
specifications chosen, that steady state oscillations in 
height are within + or - one foot from a desired height 
signal and that this condition is reached in no more than 
four missile time constants. The specific missile being 


Simulated has a time constant approximately equal to one 
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second, therefore a steady state condition should exist 
within four seconds from initial missile release. Although 
it is not specifically the goal of the controller designed 
in this simulation to respond quickly to step changes in 
neight, this would be a desirable characteristic of 
operation and would increase the value of the model. 

Further assumptions include the existence of a gyro on 
board the missile to provide the missile pitch angle (y), an 
altimiter to provide missile height above the earth 
reference plane, and a clock timer and assoclated 
electronics to determine the vertical acceleration of the 
missile (d2y/at?). It has been assumed that no relative 
wind exists for simplicity. Using the approximation that 
the angle of the velocity vector above the horizontal 


reference plane (8) is 


8 < tan ![dy/dt) / (dx/dt)] 


it is evident that the missile attack angle (a) can be 


obtained as: 


Thus the necessary information is provided to make use of 
the previously derived missile equations of motion to begin 


the altitude controller. 
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A. UNCOMPENSATED MISSILE PLANT 

The missile dynamics are combined with the fin 
Somer oler rn Fig. sel. This system to be controlled has 
three inputs. The primary input signal provides voltage 
through a power amplifier to drive the fin controller which 
then positions the control fins to provide the fin angle (6) 
input to the missile model. The Secondary input , but of 
great significance is the input that comes from the 
acceleration caused by the gravity acting on the mass of the 
missile itself. Finally a fin bias voltage (Vb) must be 
applied to help counteract the initial application of the 
missile weight to the system dynamic equations. The effect 
of the fin bias is to increase the initial system 
Stabilization time dramatically. Without it the missile 
will fall a great deal before the system can catch up to 
this initial weight input. 

TO assist in controller design, in addition to 
calculation of the equivalent transfer function of the fin 
controller, Program 1 (appendix C) also calculates missile 
system parameters K; ehrouch Kor and the overall 
uncompensated missile plant transfer function. All missile 
and fin parameters can be changed within this program. 
Sample output is provided in appendix B for the parameters 
used in this simulation. 

It is seen from appendix B that the uncompensated 


missile plant yields a 7th order type one system with one 
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zero. Several sets of missile parameters were evaluated. 
In general a mechanical resonance occurs in the open loop 
Bode plot at approximately one radian per second input 


frequency, see Fig. 5.2. 


B. COMPENSATION OF MISSILE PLANT 

The mechanical resonance 1s evidenced by the presence of 
two complex roots in the uncompensated missile transfer 
function near the resonance peak as seen on the Bode plot of 
the uncompensated plant. 

The most common first approach to compensating for a 
mechanical resonance is to decrease the system gain such 
that the resonance peak falls well below (at least 6 dB) the 
0 gain crossover point. The problem that occurs, however is 
that a minimum bandwidth of 6.28 radians per second should 
be achieved to insure adequate response for systems down to 
l second time constants. Adding some conservatism to this 
bandwidth requirement calls for a system bandwidth 
requirement of approximately 10 radians per second. 

The above observations and previously established design 
requirements lead to the idea of the possible employment of 
a PID controller to compensate for the dominant complex 
roots of the uncompensated plant. In theory once this is 
accomplished it should be a relatively simple matter to use 
Lead-Lag compensation to adjust the open loop Bode response 


of the system transfer function for proper phase margin and 
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bandwidth for a well damped quick responding plant. Recall 
that the uncompensated system is type one, and that a PID 
controller also adds a pole at Ø to the overall system. 
This should allow zero steady state error to ramp inputs, 
but also necessitates the use of two Lead compensator 
sections to provide the necesary system phase margin 
required. 

The compensated system block diagram is shown in Fig. 
Sosa Unless changes to motor or missile parameters are 
relatively small, the system will need to be recompensated. 
The first step to recompensate is enter the new parameters 
in the Basic program to determine the uncompensated missile 
transfer function then use this as the basis for the Bode 
plot: Next, because the zero of this transfer function is 
always nearly cancelled by one of the real roots of the 
function, the main consideration is the set of dominant 
complex roots. These roots can be multiplied to give the 
equivalent second order polynomial in coefficient form. The 
PID controller contributes the following transfer function 


to the forward transfer function of the missile plant: 


£ 2 
VPID = [ (KKh)S z (KKp)S v (KK,)] 745 


The complex roots of the system can therefore be cancelled 
by coosing the PID constants equal to the coefficients of 


the above derived second order system polynomial. The next 
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Step is to include this transfer function along with two 
lead sections in the forward system transfer function for 
the Bode analysis. 

One method that works well for choosing the proper lead 
compensator sections to give a system bandwidth above 19% 
radians per second is to place a zero at .l and a zero at 
300 then use the second Lead section to fine tune the open 
loop Bode plot to give a phase margin of 45 to 55 degrees. 
For the parameters of the system as indicated previously 
placing the second zero at .8 and the pole at 15 satisfies 
the originally specified design requirements, see Fig. 5.6 
for the output response to a zero reference signal input. 
Also see Fig. 5.7 and Fig 5.8 for response to step inputs to 
provide a missile climb of 100 feet and a missile drop in 


altitude of 10 feet respectively. 
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Figure 5.1 Uncompensated Missile Plant 
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Figure 5.3 Compensated Missile Plant 
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Figure 5.4 Open Loop Compensated Missile Plant 
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Figure 5.5 Closed Loop Compensated Missile Plant 
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Figure 5.7 Step Response to +100 
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VI. CONCLUSIONS AND RECOMENDATIONS 


A. CONCLUSIONS 

The CSMP model results for simulations as described in 
section V. were confirmed to be within .001% of the FORTRAN 
language model for the cruise missile altitude hold 
controller under the same test conditions. 

The missile system altitude hold controller meets and 
exceeds original design requirements established for the 
study of the effects of real load requirements on a DC motor 
having similiar parameters to state of the art brushless DC 
motors. Steady state oscillations in height were less than 
.l ft. as compared to the design specification of less than 
or equal to one foot. Settling time was less than 4 sec. 
for all simulations. This meets or exceeds the design 
specification on settling time of less than or equal to 4 
time constants (time constant of the simulated missile is 
approximately 1 sec.). The system gain had to be lowered by 
a factor of 10 to allow the compensator output to better 
1nteract with the vertical velocity feedback of the system. 
This factor along with saturation of the fin position 
controller during transient operation caused some steady 


state error to input reference signals. This effect can be 
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counteracted by choosing reference signals appropriate to 
establish the desired output height. 

The closed loop bandwidth of the fin controller is large 
for a servo mechanism. This is theoretically possible since 
large input voltages are used and because the load inertia 
felt on the motor is inversly proportional to the gear 
reduction ratio. The large bandwidth should be further 
investigated for actual values of load inertia from the fin 


mechanism. 


BR RECOMMENDATIONS 

For future work it is highly recommended to establish 
within the simulation program a means for adapting the 
controller to the desired changes in system parameters. 
Other means of control may be investigated, in particular 
incorporating feedback compensation other than proportional. 
In addition the steady state error problem requires further 


study to specifically identify and correct its sources. 


48 


Symbol name 


Af 

Am 
Arm(L2) 
Atkang (a) 
Beta (8) 
BL 

Bm 

BE 

Cd 

Cg 

GALE 


Finang (6) 
Findeg 
Finsiz(Af) 
Gamma (Y) 
Grav 

Hk 


APPENDIA A: 


Oo SSMIBOGS 


Description/Units 


area of fin surface a) 
missile lift surface (ft^) 

fin moment arm (ft) 

missile attack angle (radians) 

angle of Vm wrt horizontal (radians) 
viscous load. friction (o2-in/rad/s) 
viscous motor friction (oz-in/rad/s) 
totalkiscous frietion (02-in/rad/s) 
coefficient of drag 

missile center of mass 

fin co fficient of lift 

fin load torque generator lift coefficient 
missile coefficient of lift 

moment constant of aerodynamic body 
missile center of pressure 

center of fin rotation 

second derivative wrt time of a variable 
first derivative wrt time of a variable 
motor Integral control output 

motor integ-prop control output 
metaorsprop"*control output 

missile position error 

fin position error 

fin position (rad) 

LIM BDCGSIELlON (degrees) 

¡cares ob fins (ft) 

missile axis angle wrt ref direction (rad) 
Gravity constant 32 (ft/s^) 

missile position feedback constant 
missile commanded height (ft) 

motor current (amps) 2 

fin system inertia (oz/in/s") 

fin system inertia thrgugh gear reduction 
TEEN (oz/in/s ) 2 
total motor system inertia (oz/in/s”) 
missile constant 

missile constant 

missile constant 

missile constant 

missile constant 

back emf constant (volts/rad/s) 

tack feedback plus motor back emf 
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Kh 

Ki 
KKd 
KKi 
KKp 
Knvrt 
Kp 
Kpwr 
Kt 
Ktac 
EL 

EZ 

EEE 
LEZ 
Lm 
Mass 
Missiz(Am) 
N 
Nalph 
Ndelt 
Pl 

P2 

Phi (9) 
Pwr 
Qk 

Ra 
Roe (P) 
Srg 
Terr 
Theta 
TI 

Tm 
Tmissu 
Vafin 
Vb 
Vbias 
Vair 
Velfed 
Vinpwr 
Mine 
Vprop 
Wm 

Wn 

Wt 

X 

Y 

2 

Zali 

22 


missile position feedback constant 

motor compensator integral constant 
missile compensator derivative constant 
missile compensator integral constant 
missile compensator proportional constant 
motor position feedback constant - 
motor compensator proportional constant 
power amplifier gain E 
motor torque constant (oz-in/amp) 
tachometer feedback constant 

distance from Cg to COMES) 

distance from Cg tos rm EC) 

missile lead filter 1 

missile lead filter 2 

missile length (ft) 

mass of missile 2 

lift area of missile (ft^) 

gear reduction ratio 

fin aerodynamic parameter 

missile aerodynamic parameter 

missile compensator pole 

missile compensator pole 

missile ref direction angle to earth surface 
motor power (watts) 

aerodynamic quality constant 

motor armature resistance (ohms) 

air density (slugs/ft“) 

rate feedback constant of missile 
motor-load torgue error 

motor shaft position (rad) 

fin load torque (oz-in) 

motor torque (oz-in) 

uncompensated missile transfer function 
voltage applied to vin (volts) 

fin bias voltage (volts) 

fin bias voltage (volts) 

missile compensator derivative sect. output 
missile velocity feedback signal 

input signal to power amp 

missile compensator integral sect. output 
missile compensator integral sect. output 
motor speed (rad/s) 

normal force due to missile weight 
missile weight (pounds) 

missile ref. flight direction, horizontal 
vertical coordinate axis 

transverse coordinate axis 

missile compensator zero 

missile compensator zero 
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REPENDI B: 


PROGRAM 1 OUTPUT 


kkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkk kkk kk kkk kkk kkk kk 


UNCOMPENSATED MOTOR TRANSEER FUNCTION: 


SS e leet, Sab, 


kkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkk kkk kkk 


COMPENSATED MOTOR FORWARD TRANSFER FUNCTION G(S)=GC(S)G1(S): 
S(3180) + (1590) 


SSS OZON OSI 760..8125) + (125.5584) 


kkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkk 


COMPENSATED FIN CONTROL SYSTEM GEQ(S)=G(S)/(1+G(S)H(S)): 
S (3188) + (1590) 


SOS (176,381257 7 S(1113126) + (556500) 


kkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkKk 


MISSILE EQUATION OF MOTION COEFFICIENTS: 


(182.6304) * ATKANG - (18.263904) * GAMMA - WN 


YDDOT 


GDDOT (18.26) * EINANG - (219156) * ATKANG - (2.739)* GDOT 


Kk k k k k k k k k k k k k k k k k k k k k k k k k k k k k k k k k k k k k k k k k k k k k k k k k k k k k k k k k k k Kk 


UNCOMPENSATED MISSILE TRANSFER FUNCTION: 


S(9545876) + (4772938) 
TMISSU = -----------------------------------2-2-------2-------- 


S°3(2.59E+97)+S°2(1.697E+97)+S(2386469) 


kkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkk 


SRG = 2 KPWR = 1 WT = 1900 VM - 2000 
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APPENDIN NE: 


PROGRAM l LISTING 


REM THIS PROGRAM IS WRITTEN IN BASIC LANGUAGE AND WILL 
REM RUN ON MOST PERSONAL COMPUTERS 

REM THE PURPOSE OF THIS PROGRAM IS TO DETERMINE TRANSEER 
REM FUNCTION COEFFICIENTS FOR MOTOR AND UNCOMPENSATED 
REM MISSILE USING VARIABLE SYSTEM PARAMETERS 

REM 

REM NOTE: MOST BASIC INTERPRETERS REQUIRE LINE NUMBERS 
REM TO PRECEED THE PROGRAM STATEMENTS. INCLUDE THESE 

REM IN THE ACTUAL PROGRAM. 


REM 

KP - 200 

KI = 100 

KT = 15.9 

KNVRT = 35 

N = 10 

BM = .00015 

BL = „0015 

BT = BM + (B./(N°2)) 
RA = 2.74 

KTAC = 1 

KB = .112 

KBAC = KTAC + KB 

JM = .001 

JL = FROM 

IT = JM (JANË 
CL = „1 


ARM = „132 
ROE = „002378 


AF = 2 
VM = 2000 
REM 


REM THIS PORTION DETERMINES THE UNCOMPENSATED MOTOR 

REM TRANSFER FUNCTION 

REM 

PRINT "RRR RRR KK KKK KKK KKK KK KKK RK KKK RRR KEK KEK KKK KKK KK KR KKK KN 


KTL = (CL*ARM*ROE*AF*VM*VM)/2 


D2 = JT*RA*N 
DL = (RA*BT*N)+(KT*KBAC*N) 
DØ = KTL 


PRINT "UNCOMPENSATED MOTOR TRANSFER FUNCTION: " H 

PRINT 

PRINT " "RECE 

PRINT "GL(S) = ------------------------------------------- 4 
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PRINT | SD 2 + LB JC 

BRINT 

PRINT Wkxkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkll 
REM 

REM THIS PORTION OF THE PROGRAM DETERMINES THE COEFFICIENTS 
REM OF THE FORWARD TRANSFER FUNCTION OF THE MOTOR 
REMEWDERE TESTS LË SJ 

REM 

Nl = KP * KT 

NG = KI * KT 

PRINT "COMPENSATED MOTOR FORWARD TRANSFER FUNCTION" 

PRINT 1G (5) GCS] CGI (S5) :” 


PRINT 
PRINT " S ESNI; yo + (NO ES m 

PM MEL ee OE ZE S oa " 
PRINT 11 S25) + So BI) + SODA" 

PRINT 


PRINT Oy ok kk kk kk kkkkkkkkkkkkkkkkkk kkk kk kk kkk kkk kkk kk kk kk kkk! 


REM 

REM THIS PORTION DETERMINES THE EQUIVALENT TRANSFER 
REM FUNCTION OF THE COMPENSATED MOTOR SYSTEM INCLUDING 
REM TiiEmEEEDBACE r BOOb 


REM 

El = Nl 
EQ - NU 
F3 - D2 
F2 = DL 


Fl = DO + (N1*KNVRT*N) 

FO = NO * KNVRT * N 

PRINT "COMPENSATED FIN CONTROL SYSTEM" 

PRINT “GEQ(S) = G(S)/(1+G(S)H(S)):" 

PRINT 

PRINT n Du mL) + GRABIE "JR 

PENN eB) na " 
PRINT " SS ESS) 55 (-F2;")+S5 (ml) +(";3B0;”)” 
PRINT 

PRINT VUAAXAKAKAKAAKAKAKAKAAKAKKAKKKAKKAKAKAKKKAKKAKAKAKAAKAAKAAKAAKAAAAKAAAAKAAKAAAAAAA AA 
REM 

REMe thts Veo rey DETERMINES THE COEFFICIENTS FOR THE 

REM UNCOMPENSATED MISSILE EQUATIONS OF MOTION. 

REM 

QK = (ROE*VM*VM) /2 


AM = 12 
CD = .Øl 
L2 = 5 

LI = I 

LM = 10 
CMO = 45 
GRAV = 32 
WT = 1000 


MASS = WT / GRAV 


DES 


IZ 
NDELT 
NALPH 
K1 
K2 
K3 
K4 
K5 
PRINT 
PRINT 
PRINT 
PRINT 
PRINT 
PRINT 
PRINT 
REM 
REM 
REM 
REM 
REM 
REM 


(1/12) * MASS * LM * LM 

CL * AF * QK 

CL * AM * QK 

NALPH / MASS 

(CD * AM * QK) / MASS 
(NDELT * L2) / IZ 
(NALPH * Ll) / IZ 

((CMQ * AM * LM * LM * QK) / (2 * VM)) / IZ 
"MISSILE EQUATION OF MOTION COEFFICIENTS 


° 
e 


“YO (";K1;") * ATKANG 


- (";K2;") * GAMMA - WN" 


"GDDOT= (';K3;")*FINANG=(";K4;'")*ATKANG=(";K5; ") *GDOT" 


Uikkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkii 


THIS SECTION INCORPORATES THE FIN CONTROLLER AND 
MISSILE EQUATIONS OF MOTION ALONG WITH A VERTICAL 
VELOCITY FEEDBACK LOOP AND POWER AMP TO FORM THE 
BASIC MISSILE SYSTEM THAT IS TO BE CONTROELED. THUS 
WE HAVE TMISSU, (THE UNCOMPENSATED MISSILE TRANSFER 


REM 
REM 
SRG 
KPWR 
Ml 
NN1 
NNO 
DD 7 
DD6 
DDS 
DD4 
DD3 
DD2 


K 


FUNCTION). 


10 

l 
PWR * K3 * 
EL * MI 
EG * MI 
ES 

(F2) + 
(Fl) + 
(FO * SRG) 
(EO SSR 


(K1 RZ) 


(E3 * K5) 
(FZ * K5) ZI EIER 
+ (El * K5) + (F2 * K4) 
+ (Fl * K4) 
(FØ * K4) + (El * (M1/SRG)) 
EG * (M1/SRG) 
"UNCOMPENSATED MISSILE TRANSFER FUNCTION: " 


SEMTSSU 


S (= NN) NN) 


S^4(";DDA; LES 3(":DD3s 19 2:7 DD2; ss (GD ae 


lkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkkk!ł 


"SRG "; SRG; " KPWR = ";KPWR;" WT = ";WT;" VM “VM 
"LENGTH SEM 
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APPENDIX D: 
PROGRAM 2 LISTING 


//FRANKLIN JOB (2832,0116),'FRANKLIN',CLASS=C 
//*MAIN ORG-NPGVM1.2832P 

// EXEC CSMPXV 

//X.COMPRINT DD DUMMY 


//X.SYSPRINT DD DUMMY 
VOTE ae 
INITIAL 
CONSTANT BM = 0.00015, BL = 0.0015, KT = 15.9 
CONSTANT JL = 0.01, PI 2939714159265 
CONSTANT JM = 0.001, KB = 0.112 
CONSTANT LA = .0016, RA = 2.740, N = 10.90 
PARAMETER THFSAT = 13.0, ARM = 0.132, ROE = 0.002378 
PARAMETER MISSIZ = 12.0, FINSIZ = 2.0, AIRSPD = 2000. 
PARAMETER WT = 1000.,L1 = 1.0, L2 = 5.0, LM = 10. 
PARAMETER CLF "S pO = ql 
PARAMETER GRAV = 32.,CD = .0@1, CMQ = .5, LAMBDA = 0. 
PARAMETER Z1 - @.1, Pl = 200., 22 = 5., P2 = 59. 
* KT -- TORQUE CONSTANT (OZ-IN/AMP) 
* KB -- BACK EMF CONSTANT (VOLT/RAD/S) 
* RA -- RESISTANCE OF THE MOTOR (OHM) 
* BM. TI SEOUSEERTETION COERBICIENT OF THE MOTOR 
È (OZ-IN/RAD/S) 
* BL -- VISCOUS FRICTION COEFFICIENT OF THE LOAD 
* BLP -- VISCOUS FRICTION COEFFICIENT OF LOAD THROUGH 
x REDUCTION GEARS 
* BT O—OTPALSUDSCOUSQGERICTTON OF THE MOTOR SYSTEM 
* JM -- INERTIA OF THE MOTOR (OZ-IN/S-S) 
* JL -- INERTIA OF THE LOAD 
* JLP -- INERTIA OF THE LOAD THRU REDUCTION GEARS 
* JT -- TOTAL INERTIA OF THE MOTOR SYSTEM 
* Al = LA/RA -- THE ELECTRICAL TIME CONSTANT OF THE 
` MOTOR 
E BT -- THE MECHANICAL TIME CONSTANT OF THE 
` MOTOR 
NOSORT 
DLE BE (N**2) 
JEPARZ"JEZ(N*:2 
MES E JEP 
BT > BM + BLP 
A1 LA / RA 
A2 JU BT 
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MASS - WT / GRAV 

Iz = (1.2) MASS L Ak 
XDDOT 0.0 

GDDOT 0.0 


* CONTROL PARAMETERS 
VXINIT = AIRSPD 
VM = AIRSPD 


KI 190.0 
KP = 200.0 
KTAC = 1,9 
KNVRT = 35.0 
KKI = 21.0 
KKP = 3.0 
KKD = 1.0 
TN ME 
INVP1 = 1.0/P1l 
INVZ2 = 1.0772 
INVP2 1.0/pe 
KPWR = 1. 
VBIAS = 82, 
SRGN- 12: 
HK = 1.0 
DYNAMIC 
* INPUT SECTION 
HREF = -10. 


* BEGIN MISSLE CONTROL SECTION 
EPSH = HREF - (HK * Y) 
LLl = LEDLAG(0.0001,INVZLl,INVPL,EPSH) 
LL2 = LEDLAG(0.0001,INVZ2,INVP2,LL1) 
VPROP = LL2 * KKP 
VINT = KKI * INTGRL(0.0,LL2) 
VDIR = KKD * DERIV(0.0,LL2) 
VPID = VPROP + VINT + VDIR 
VELFED = (SRG * YDOT) 
VINPWR = (VPID/10.) - VELFED 
VPWR = VINPWR * KPWR 
VA = VPWR + VBIAS 
VAFIN = LIMIT(-160.,160.,VA) 


* BEGIN EIN CONTROL"SEGCPEGHN 
ERRI = VAFIN - (KNVRT * THETA) 
* PROPORTIONAL INTEGRAL CONTROL 
EPROP = ERRI * KP 
EINT = KI % INTGRL (9.9 ,ERR1) 
EPI = EPROP + ENA 
* TACHOMETER FEEDBACK PLUS BACK EMF 
KBAC = (KTAC + KB) 
VBACK = KBAC * WM 
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* * * * * 


ERR2 = EPI - VBACK 


MOTOR MODEL 
IM = ERR2 * (1.9/RA) 
TM = IM * KT 
TERR = TM + TL 
WM = REALPL (9.0,A2,TERR/BT) 
WMRPM = WM * (39./PI) 
THETA = INTGRL (0.0,WM) 
MOTOR SHAFT POSITION 
THDEG = THETA * (180./PI) 
WMFIN = WM / N 
FIN POSITION (POSITIVE IS UPWARD MOVEMENT OF AFT 
PORTION OF FIN) 
FINANG = THETA / N 
FINDEG = FINANG * (180./PI) 
PWR = WM * TM * .0070615 


FIN LOAD TORQUE RESULTING FROM DYNAMIC FIN DEFLECTION 
CLL = -(8.1 * LIMIT(-THFSAT,THFSAT,FINDEG)) 
TL = ARM * ((ROE)/2) * FINSIZ * (AIRSPD**2)*CLL 


MISSILE MODEL 
FIN POSITION IS INPUT TO THE MISSILE MODEL HERE AS 
FINANG IN RADIANS 
AIRSPD USED HERE FOR SIMPLIFICATION AND (I.C.) 
RATHER THAN VM 
OHNE WROSESEFJATRSPD * ATRSPD) / 2. 
NDELT = CLF * FINSIZ * OK 
NALPH = CLM * MISSIZ * QK 
Kl = NALPH 
K2 = CD * MISSIZ * ©K 
REFERENCE DIRECTION IS HORIZONTAL THEREFORE 
COS (LAMBDA)=1. 
WTN = MASS * GRAV * 1. 
K3 NDELT * L2 
KÄE INA * LI 
KS (eo * MISSIZ * LM * LM * OK) / (2. * VM) 
GDDOT = (K3 * FINANG - K4 * ATKANG - K5 * GDOT)/IZ 
GDOT = INTGRL(9.9,GDDOT) 
GFENMINEGRE (8.02 ,GDOT) 
EEG ME * (182./PI) 
YDDOT = ( Kl * ATKANG - K2 * G - WTN)/ MASS 
YDOT = INTGRL(09.9,YDDOT) 
Y = INTGRL(09.9,YDOT) 
XDDOT = 0.0 
XDOT = INTGRL(VXINIT,XDDOT) 
X = INTGRL(0.0,XDOT) 
VM = (XDOT **2 + YDOT **2)**Q.5 
BETA = ATAN2 (YDOT,XDOT) 
BETDEG = BETA * (180./PI) 
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ATKANG - G - BETA 
ATKDEG ATKANG É (180./BI) 


TERMINAL 


TITLE MISSILE ALTITUDE HOLD CONTROLLER 
METHOD RKSEX 
TIMER FINTIM = 10.90 ,OUTDEL=.1,PRDEL=.1,DELT=.0001 
OUTPUT Y,BETDEG,GDEG,ATKDEG,FINDEG 
PRINT ATKDEG,FINDEG,Y 
LABEL MISSILE PARAMETERS 
PAGE MERGE 
END 
STOP 


ENDJOB 


PEN 
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